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— ^ (57) Abstract: The invention concerns a method for determining the position of an object (1) in a space, whereby the measurement 
parameters (4) of said object (1) are recorded with an optical photographing system (3) calibrated on a spatial system of coordinates 
(5) and the position of the object (1) in the spatial system of coordinates (5) is determined. In order to be able to determine in 
reliable manner the position, even with a limited number of photographing devices, it is proposed to detect simultaneously at least 
two measurement parameters (4) of the object (1) in a photographing device (3) and to use them to determine the position of the 
object (1). 
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(57) Zusammenfassung: Es wird ein Verfahren zur Bestimmung der Lage eines Objekts im Raum (1) beschrieben, bei dem Mess- 
merkmale (4) des Objekts (1) mit einer auf ein Raum-Koordinatensystem (5) kalibrierten optischen Aufnahmeeinrichtung (3) auf- 
genommen werden und anhand dieser Messmerkmale (4) in einer Bildverarbeitungseinrichtung die Lage des Objekts (1) in dem 
Raum-Koordinatensystem (5) bestimmt wird. Um eine zuverlassige Ermittlung der Lage auch mit wenigen Aufnahmeeinrichtungen 
zu ermoglichen, ist vorgesehen, dass mindestens zwei Messmerkmale (4) des Objekts (1) in einer Aufnahmeeinrichtung (3) gleich- 
zeitig erfasst und zur Bestimmung der Lage des Objekts (1) herangezogen werden. 
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Verfahren zur Bestimmung der Lage eines Objekts im Raum 

5 Die Erfindung betrifft ein Verfahren zur Bestimmung der Lage eines Objekts im 
Raum, bei dem Messmerkmale des Objekts mit einer auf ein Raum- 
Koordinatensystem kalibrierten optischen Aufnahmeeinrichtung aufgenommen 
werden und anhand dieser Messmerkmale in einer Bildverarbeitungseinrichtung 
die Lage des Objekts in dem Raum-Koordinatensystem bestimmt wird. Derartige 
10 Verfahren finden bspw. bei Produktions- und Montagevorgangen in automati- 
sierten Produktionsstrafien Anwendung, bei denen mittels Handhabungsgeraten 
ein Arbeitsvorgang an einem Fertigungsobjekt unbekannter Lage durchgefuhrt 
werden soli. 

15 In der EP 0 911 603 B1 ist zur optischen Bestimmung der Lage eines starren 
Korpers in einem raumlichen Koordinatensystem beschrieben, jede aus einer 
Auswahl von mindestens drei auf dem starren Korper vorhandenen Linien oder 
Kanten, deren Bezug zum korpereigenen Koordinatensystem bekannt ist, in 
einem ebenen Koordinatensystem abzubilden, wobei die Lage der ebenen 

20 Koordinaten auf das raumliche Koordinatensystem bezogen ist und auf eine 
Zuordnung ausgezeichneter Punkte verzichtet wird. Die Kanten oder Linien 
werden in der Regel durch mehrere Kameras erfasst, wobei es auch moglich ist, 
eine in Bezug auf das raumliche Koordinatensystem kontrolliert bewegbare 
Kamera heranzuziehen und nacheinander mehrere Aufnahmen der Linien oder 

25 Kanten zu machen. 

Dabei besteht jedoch der Nachteil, dass entweder mehrere Kameras eingesetzt 
und gesondert kalibriert werden mussen oder die Bestimmung der Lage des 
Objekts im Raum lange dauert, weil mehrere Bilder aus unterschiedlichen Posi- 
30 tionen aufgenommen werden mussen. 

BESTATIGUNGSKOPIE 


WO 2005/075936 


PCT/EP2005/000971 


Aufgabe der vorliegenden Erfindung ist es daher, eine Moglichkeit zur Bestim- 
mung der Lage eines Kdrpers im Raum vorzuschlagen, die eine zuverlassige 
Ermittlung der Lage eines Objekts im Raum mit weniger Kameras oder Kamera- 
5 positionen zulasst. 

Diese Aufgabe wird bei einem Verfahren der eingangs genannten Art im We- 
sentlichen mit den Merkmalen des Anspruchs 1 gelost. Dazu werden mindes- 
tens zwei Messmerkmale des Objekts in einer Aufnahmeeinrichtung gleichzeitig 

10 erfasst und zur Bestimmung der Lage des Objekts herangezogen. Hierzu wer- 
den die Messmerkmale, deren Koordinaten in ihrem eigenen Koordinatensys- 
tem, insbesondere einem Objekt-Koordinatensystem, bekannt sind bzw. durch 
die Bildverarbeitung ermittelt werden konnen, in einem zweidimensionalen 
Koordinatensystem der Aufnahmeeinrichtung abgebildet. Da die durch die Posi- 

15 tion und Ausrichtung bestimmte Lage der Aufnahmeeinrichtung im Raum-Koor- 
dinatensystem und deren Abbildungseigenschaften bekannt ist, kann die Bild- 
verarbeitung uber an sich bekannte Auswerteverfahren eine Relation zwischen 
den in dem zweidimensionalen Koordinatensystem der Aufnahmeeinrichtung 
abgebildeten Messmerkmalen und dem Raum-Koordinatensystem herstellen. 

20 Uber den bekannten Bezug der verschiedenen Messmerkmale zueinander in 
dem Objekt-Koordinatensystem kann dann auf die Anordnung der aufgenom- 
menen Messmerkmale im Raum riickgeschlossen werden. Dies lasst eine La- 
gebestimmung des Objekts im Raum zu. Dabei konnen erfindungsgemaft auch 
Messmerkmale zu mehreren Gruppen zusammengefasst und in verschiedenen 

25 Teilmessungen erfasst werden, wobei die Koordinaten der Messmerkmale in 
einer Gruppe relativ zueinander bekannt sind, ohne dass die Koordinaten relativ 
zu Messmerkmalen anderer Gruppen ebenfalls bekannt sind. Durch Zusammen- 
fassung der verschiedenen Teilmessungen konnen die Koordinaten des Ge- 
samtkorpers mit erhohter Genauigkeit bestimmt werden. 


30 
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Bisher wurde angenommen, dass die optischen Achsen der Messeinrichtungen, 
mit denen die verschiedenen Messmerkmale zur Lagebestimmung aufgenom- 
men wurden, im Raum unterschiedlich ausgerichtet sein mussen, um mathema- 
tisch stabile Losungen der Auswertealgorithmen erreichen zu konnen. Dies hat 
5 es erforderlich gemacht, jedes Messmerkmal, das zur Bestimmung der Lage 
des Objekts im Raum herangezogen wurde, aus einer anderen Kameraposition 
aufzunehmen. Dies wurde entweder durch eine Vielzahl von Kameras erreicht, 
die an verschiedenen Orten aufgebaut und jeweils kalibriert sind, und hatte 
einen entsprechend grofien apparativen Aufwand zur Folge. Altemativ konnte 

10 die Kamera auch nacheinander kontrolliert in verschiedene Aufnahmepositionen 
bewegt werden. Dies fuhrte jedoch zu einer vergleichsweise langsamen Lage- 
bestimmung, da alle Bilder nacheinander ausgewertet werden mussten. Mit der 
vorliegenden Erfindung hat sich nun herausgestellt, dass es moglich ist, mehre- 
re Messmerkmale mit einer Kamera gleichzeitig zu erfassen und fur die Lagebe- 

15 stimmung im Raum heranzuziehen. Dadurch wird die Geschwindigkeit bei der 
Bestimmung der Lage eines Objekts im Raum erheblich beschleunigt. Beson- 
ders vorteilhaft ist es dafiir, wenn die verschiedenen, in einer Kamera erfassten 
Messmerkmale auf dem Objekt einen deutlichen, insbesondere mdglichst gro- 
flen Abstand aufweisen. Die erreichbare Genauigkeit hangt insbesondere von 

20 dem Abstand der Messmerkmale auf dem Objekt ab. Je nach gewunschter 
Genauigkeit kann daher ein bestimmter Abstand als Mindestabstand zwischen 
zwei Messmerkmalen vorgegeben werden. Bei geringeren Anforderungen an die 
Genauigkeit kann das erfindungsgemafte Verfahren jedoch auch mit dicht ne- 
beneinander liegenden Messmerkmalen durchgefuhrt werden. 

25 

Um die Lage eines Objekts im Raum, d. h. dessen Position und Orientierung, 
genau ermitteln zu konnen, mussen alle sechs Freiheitsgrade des Objekts be- 
stimmt werden. Dies kann erfindungsgemafi durch Auswertung von mindestens 
drei Merkmalen aus mindestens einem aufgenommenen Bild erreicht werden. 
30 Die Bestimmung einer Objektposition und -orientierung ist also durch Auswer- 
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tung von drei Messmerkmalen moglich, die in einer oder in mehreren Aufnah- 
men identifizierbar sind. Besonders vorteilhaft ist es dabei, wenn alle zur Aus- 
wertung benotigten Messmerkmale mit einer Aufnahme erfasst werden. Es ist 
jedoch erfindungsgemaft auch moglich, bspw. eines der drei benotigten Mess- 
5 merkmale mit einer zweiten Aufnahmeeinrichtung Oder einer zweiten Aufnah- 
meposition der einen Aufnahmeeinrichtung zu erfassen. Durch die Zusammen- 
fassung von mindestens zwei Merkmalen in einer Aufnahmeeinrichtung wird 
bereits eine erhebliche Verbesserung im Hinblick auf den apparativen Aufwand 
und/oder die Auswertegeschwindigkeit erreicht. 

10 

Mit nur drei Messmerkmalen kann jedoch kein Restfehler bestimmt werden. Bei 
Verwendung von vier oder mehr Messmerkmalen ist zusatzlich die Bestimmung 
eines Restfehlers nach einer Fehlerausgleichsrechnung moglich. Der Restfehler 
charakterisiert den Fehler zwischen der modellierten Geometrie und der Realitat 

15 und ist daher ein Mali fur die erreichte Genauigkeit. Erfindungsgemafi ist es 
jedoch vorteilhaft, nicht mehr als fiinf Messmerkmale gleichzeitig mit einer Aus- 
werteeinrichtung zu erfassen. Auch wenn der Restfehler mit der Anzahl der 
Messmerkmale abnimmt, hat es sich herausgestellt, dass eine Auswertung von 
mehr als funf Messmerkmalen in einem Bild bei den bekannten Auswertemetho- 

20 den nicht mehr zu einer signifikanten Verbesserung des Fehlers fuhrt. Daher 
kann zur Vermeidung unnotiger Auswertearbeit auf eine grofiere Anzahl von 
auszuwertenden Messmerkmalen in einem Bild einer Auswerteeinrichtung ver- 
zichtet werden. 

25 Je nach Anwendungsfall ist es moglich bzw. ausreichend, die Bestimmung der 
Lage des Objektes mit weniger als sechs Freiheitsgraden durchzufuhren. Dabei 
sind beliebige Untermengen moglich. Bei einem zwei- oder eindimensionalen 
Messergebnis kann die Anzahl der notwendigen Messmerkmale aufgrund der 
reduzierten Freiheitsgrade auf zwei bzw. eins verringert werden. Prinzipiell ist 

30 die Bestimmung der Lage des Objektes in sechs bis ein Freiheitsgraden mog- 
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lich. Die Bestimmung von funf und sechs Freiheitsgraden wird durch mindestens 
drei Messmerkmale, die Bestimmung von drei und vier Freiheitsgraden durch 
mindestens zwei Messmerkmale und die Bestimmung von einem und zwei 
Freiheitsgraden durch mindestens ein Messmerkmal moglich. Auch die Erfas- 
5 sung von nur einem Messmerkmal in einer Aufnahmeeinrichtung kann mit einem 
erfindungsgemafien Aufnahme- und Auswertesystem durchgefuhrt werden, das 
zur Durchfuhrung des erfindungsgemafien Verfahrens eingerichtet ist. 

Gemaft einer Ausgestaltung des erfindungsgemafien Verfahrens handelt es sich 

10 bei den Messmerkmalen insbesondere um ausgezeichnete Punkte, d. h. punkt- 
formige Merkmale, die selbst keine Orientierung im Raum aufweisen. Eine sol- 
che Orientierung der Messmerkmale im Raum ist fur die Anwendung des erfin- 
dungsgemalien Verfahrens im Gegensatz zu vielen aus dem Stand der Technik 
bekannten Methoden nicht notwendig und bietet im Vergleich zu Kanten bspw. 

15 den Vorteil, dass die Position eines ausgezeichneten Punktes im Raum immer 
eindeutig ist. Bei einer Kante Oder einer anderen geometrischen Kontur ist da- 
gegen zunachst nicht bekannt, welcher Punkt der Kante genau erfasst ist. Das 
erfindungsgemafte Verfahren lasst sich jedoch auch bei Messmerkmalen an- 
wenden, die als Kanten (mathematische Kurven, Geraden) oder sonstigen be- 

20 schreibbaren geometrischen Formen ausgebildet sind, wobei sich in diesem Fall 
der Auswerteaufwand erhoht. Bei einer Kante kann der Winkel der Kante im 
Raum als zusatzliche Randbedingung verwendet werden, um die Robustheit 
und Stabilitat des mathematischen Losungsmodells zu erhohen. Das Verfahren 
lasst sich erfindungsgemafi auch bei einer Konturauswertung mit beliebig vielen 

25 Punkten anwenden. 

Obwohl das Verfahren gut mit einer einzigen Aufnahmeeinrichtung ausgefuhrt 
werden kann, konnen erfindungsgemaft auch mehrere Aufnahmeeinrichtungen 
verwendet werden. Die Anzahl sowie die Anordnung der an der Messung betei- 
30 ligten Aufnahmeeinrichtungen kann dabei von der Ausdehnung und Geometrie 
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des zu messenden Objekts sowie der erforderlichen Genauigkeit des Messer- 
gebnisses abhangig gemacht werden. 

Gemafi einer vorteilhaften Ausgestaltung kann ein Messmerkmal auch in meh- 
5 reren Aufnahmeeinrichtungen abgebildet werden. Damit erhdht sich im Allge- 
meinen die Genauigkeit des Gesamtergebnisses um den Beitrag dieses Mess- 
merkmals, weil hierdurch eine nicht unbedingt notwendige Uberbestimmung 
erreicht und zur Erhohung der Genauigkeit ausgenutzt wird. 

10 Um eine hohe Flexibility zu erhalten, konnen erfindungsgemafi eine Oder meh- 
rere stationare und/oder insbesondere mittels eines Handhabungsgerates be- 
wegbare Aufnahmeeinrichtungen verwendet werden. Dabei konnen sich an 
einem Handhabungsgerat auch mehrere fest miteinander verbundene Kameras 
befinden. Durch den Einsatz eines Handhabungsgerates ist es auch moglich, 

15 eine Aufnahmeeinrichtung nacheinander an verschiedene Messpositionen zu 
bringen und dort Bilder aufzunehmen. Bei diesen bewegten Handhabungsein- 
richtungen muss das Handhabungsgerat entweder immer die gleichen Raumpo- 
sitionen anfahren, an denen die Aufnahmen stattfinden, oder die kalibrierten 
Koordinaten seiner eigenen Raumposition ermitteln konnen und an die Bildver- 

20 arbeitung ubergeben. 

Dies kann bspw. durch eine dreidimensionale Kalibrierung der Aufnahmeeinrich- 
tung an dem Handhabungsgerat erfolgen, so dass aufgrund der kontrollierten 
Bewegung des Handhabungsgerates die Lage der Aufnahmeeinrichtung an dem 

25 Handhabungsgerat in jedem erreichbaren Bewegungszustand bekannt ist. Es ist 
auch moglich, die Lage der Aufnahmeeinrichtung selbsttatig durch Vermessen 
von Merkmalen mit bekannten Koordinaten und/oder durch den Einsatz externer 
Messmittel zu bestimmen. Insbesondere ist es denkbar, die bewegten Aufnah- 
meeinrichtungen aufierhalb des eigentlichen Messraumes, an dem die Lage des 

30 Objektes zu bestimmen ist, zu kalibrieren, indem ein Kalibriermedium aufierhalb 
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dieses Messraumes angebracht ist. Dazu kann die zu kalibrierende Aufnahme- 
einrichtung durch das Handhabungsgerat so bewegt werden, dass das Kalib- 
riermedium durch die Aufnahmeeinrichtung abgebildet wird. Aus der bekannten 
Lage des Kalibiermediums lasst sich dann die Lage der Aufnahmeeinrichtung 
5 ermitteln und deren Kalibrierung durchfiihren. Dies hat den Vorteil, dass das zu 
vermessende Objekt vor der Kalibrierung nicht demontiert werden muss. Durch 
die vorbeschriebenen besonders vorteilhaften Kalibriermoglichkeiten wird er- 
reicht, dass fur eine bewegbare Aufnahmeeinrichtung nach einer Bewegung des 
Handhabungsgerates die Lage des Aufnahmeeinrichtung in dem Raum- 
10 Koordinatensystem bestimmt wird. Das erfindungsgemafce Verfahren ist jedoch 
von der Kalibriermethode unabhangig und kann mit beliebigen Kalibrierungen 
eingesetzt werden. 

Gemaft einer vorteilhaften erfindungsgemalien Variante wird die Aufnahmeein- 

15 richtung derail positioniert, dass zwischen in die Aufnahmeeinrichtung fallenden 
Sehstrahlen, welche von verschiedenen Messmerkmalen ausgehen und zur 
Bestimmung der Lage des Objekts herangezogen werden, jeweils ein grofier 
Zwischenwinkel besteht. Ein erfindungsgemaft grofier Zwischenwinkel ist dann 
gegeben, wenn die von verschiedenen Messmerkmalen ausgehenden Sehstrah- 

20 len nicht parallel oder im Wesentlichen parallel verlaufen. Vorzugsweise ist die 
Aufnahmeeinrichtung so positioniert, dass die oder moglichst viele Zwischen- 
winkel grofier als etwa 10° sind. Dies stellt keine scharfe Grenze dar, da die 
Grofie des Zwischenwinkels die Genauigkeit des Ergebnisses bestimmt. Bei 
entsprechend geringeren Genauigkeitsanforderungen konnen daher auch klei- 

25 nere Winkel von bspw. 5° bis 6° ausreichen. Dies gilt insbesondere dann, wenn 
nur wenige, bspw. ein oder zwei Zwischenwinkel, kleiner sind als die bevorzug- 
ten Zwischenwinkel von grdfier etwa 8° bis 10°. Entsprechende Winkelbegren- 
zungen gelten bei der Annaherung der Zwischenwinkel an 180°. In diesem Fall 
lasst sich immer noch eine ausreichende Genauigkeit erreichen. Es hat sich 

30 erfindungsgemaft herausgestellt, dass es mdglich ist, mehrere Messmerkmale 
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mit einer Kamera zu erfassen und mit ausreichender Genauigkeit auszuwerten, 
wenn insbesondere die Winkel zwischen den einzelnen, von diesen Messmerk- 
malen ausgehenden Sehstrahlen ausreichend grofi sind. Dann verlaufen die 
verschiedenen Sehstrahlen nicht parallel bzw. nicht im Wesentlichen parallel. 
5 Die erreichbare Genauigkeit bei der Positionsbestimmung wird dabei um so 
hoher, je grofier die Zwischenwinkel zwischen den Sehstrahlen sind. 

Dies gilt erfindungsgemall auch fur den Fall, dass jeweils nur ein Messmerkmal 
in der einer Aufnahmeeinrichtung erfasst wird, wobei insgesamt mehrere Auf- 

10 nahmepositionen verwendet werden (mehrere Aufnahmeeinrichtungen oder 
mehrere Positionen einer Aufnahmeeinrichtung nacheinander). Auch in diesem 
Fall ist die Ausrichtung der optischen Achsen der Aufnahmeeinrichtung(en) an 
den Aufnahmepositionen nicht entscheidend, solange die von den zur Auswer- 
tung herangezogenen Sehstrahlen verschiedener Messmerkmale ausreichend 

15 grofie Zwischenwinkel aufweisen. Daher ist ein eigenstandiger Aspekt der vor- 
liegenden Erfindung darauf ausgerichtet, ein Verfahren zur Bestimmung der 
Lage eines Objekts im Raum vorzuschlagen, bei dem Messmerkmale des Ob- 
jekts mit mindestens einer auf ein Raum-Koordinatensystem kalibrierten opti- 
schen Aufnahmeeinrichtung aufgenommen werden und anhand dieser Mess- 

20 merkmale in einer Bildverarbeitungseinrichtung die Lage des Objekts in dem 
Raum-Koordinatensystem bestimmt wird. Dabei wird die Aufnahmeeinrichtung 
derart positioniert, dass zwischen in die eine oder die mehreren Aufnahmein- 
richtung(en) fallenden Sehstrahlen, welche von verschiedenen Messmerkmalen 
ausgehen und zur Bestimmung der Lage des Objekts herangezogen werden, 

25 jeweils ein grofter Zwischenwinkel besteht. 

In der Praxis werden in der Regel ausreichende Genauigkeiten bei der Lagebe- 
stimmung erreicht, wenn die Zwischenwinkel zwischen den Sehstrahlen insbe- 
sondere in einem Bereich von etwa 10° und 170° liegen. Je nach Anwendungs- 
30 fall kann jedoch auch ein grofierer oder kleinerer Winkelbereich sinnvoll sein. 
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Eine optimale Genauigkeit wird erreicht, wenn die Aufnahmeeinrichtung je nach 
Anwendungsfall derart positioniert und/oder eingerichtet wird, dass jeweils ein 
moglichst grolier Zwischenwinkel besteht. Dies kann bspw. durch eine Abstim- 
5 mung von Aufnahmeentfernung und Brennweite des Objektivs der Aufnahme- 
einrichtung erreicht werden. Zur Erzielung moglichst groBer Winkel zwischen 
den Sehstrahlen ist der Einsatz von insbesondere kurzbrennweitigen Objektiven 
mit grofcen Offnungswinkeln forderlich. Bei solchen Weitwinkelobjektiven sind 
die Variationen von Skalierungsanderungen und projektiven Verzeichnungen 

10 der Objektabbildung in der Aufnahmeeinrichtung, welche bspw. durch eine 
Kamera mit einem CCD-Sensor gebildet wird, in Abhangigkeit der Objektlage 
und Orientierung groft, wodurch die Messgenauigkeit verbessert wird. Dabei 
wird die Aufnahmeeinrichtung vorzugsweise so nah an dem Objekt positioniert, 
dass die zur Positionsbestimmung heranzuziehenden Messmerkmale gerade 

15 noch von der Aufnahmeeinrichtung erfasst werden. Dann wird die von der Auf- 
nahmeeinrichtung angebotene sensitive Flache, bspw. ein CCD-Chip, optimal 
ausgenutzt. 

Entscheidend fur die Anwendung des erfindungsgemaften Verfahrens ist es, 
20 dass die Koordinaten der Messmerkmale in dem zu vermessenden Objekt zu- 
geordneten Koordinaten, d. h. in den Objekt-Koordinatensystem, fur die Bild- 
auswertung bekannt sind und/oder durch diese ermittelt werden konnen. Dies 
kann erfindungsgemafc dadurch erreicht werden, dass die Objektdaten mit den 
Koordinaten der Messmerkmalen der Bildverarbeitung bspw. in Form von Kon- 
25 struktionsdaten vorgegeben werden. Entsprechend einer weiteren Ausfuhrungs- 
form der vorliegenden Erfindung ist es auch moglich, die Koordinaten der 
Messmerkmale auf den Objekten zu erlernen. Dazu wird das Objekt in mehreren 
bekannten Lagen durch die Aufnahmeeinrichtung aufgenommen. Die aufge- 
nommenen Bilder werden dann entsprechend ausgewertet und die Koordinaten 
30 den jeweiligen Messmerkmalen zugeordnet. Dabei kann die Bildverarbeitung 
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bspw. alle moglichen, auf dem Objekt zur Verfugung stehenden Messmerkmale 
erfassen, so dass fur die Bestimmung der Lage des Objektes im Raum eine 
Vielzahl verschiedener Messmerkmale zur Verfugung stehen. 

5 GemafJ einer Weiterentwicklung des erfindungsgemalJen Verfahrens werden die 
Auswahl der von einer Aufnahmeeinrichtung zu erfassenden Messmerkmale, die 
Position der Aufnahmeeinrichtung und/oder die Brennweite der Aufnahmeein- 
richtung selbsttatig bestimmt. Dies bietet sich insbesondere bei bewegbaren 
Aufnahmeeinrichtungen an, da bei diesen der aufzunehmende Bildausschnitt 

10 des Objektes so ausgewahlt werden kann, dass signifikante, fur die Lagebe- 
stimmung des Objektes besonders geeignete Messmerkmale den sensitiven 
Bereich der Aufnahmeeinrichtung optimal abdecken. Dazu kann die Aufnahme- 
einrichtung bspw. ein Testbild des Objektes machen. Die Bildverarbeitung iden- 
tifiziert in diesem Testbild die erkennbaren Messmerkmale. Durch Uberprufung 

15 verschiedener Aufnahmepositionen und/oder verschiedener fur die Auswertung 
verwendeter Messmerkmale kann dann automatisch die optimale Aufnahmepo- 
sition ermittelt werden. Ggf. kann zusatzlich auch die Brennweite des Objektives 
der Aufnahmeeinrichtung angepasst werden, sofern die Brennweite bei der 
Aufnahmeeinrichtung automatisch einstellbar ist. 

20 

Weitere Vorteile, Merkmale und Anwendungsmoglichkeiten der vorliegenden 
Erfindung ergeben sich auch aus der nachfolgenden Beschreibung von Ausfuh- 
rungsbeispielen und der Zeichnung. Dabei bilden alle beschriebenen und/oder 
bildlich dargestellten Merkmale den Gegenstand der Erfindung, unabhangig von 
25 ihrer Zusammenfassung in den Anspruchen und/oder deren Ruckbezugen. 

Es zeigen: 


Fig. 1 schematisch die Bestimmung der Objektlage in einem Raum- 
30 Koordinatensystem mit einer stationaren Aufnahmeeinrichtung; 
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Fig. 2 schematisch die Bestimmung der Objektlage in einem Raum- 

Koordinatensystem mit einer bewegten Kamera und 

5 Fig. 3 schematisch die Bestimmung der Objektlage in einem Raum- 

Koordinatensystem relativ zu einer Nulllage des Objekts. 

In Fig. 1 ist ein erfindungsgemafies System dargestellt, mit dem das Verfahren 
zur Bestimmung Lage eines Objekts 1 im Raum gemafi der vorliegenden Erfin- 

10 dung durchgefuhrt werden kann. Dieses zeigt ein Objekt 1, dessen Lage im 
Raum bestimmt werden soil. Diese Anforderung besteht haufig bei Produktions- 
und Montagevorgangen in automatisierten ProduktionsstrafJen, bei denen das 
Objekt 1 bspw. durch ein Forderband oder dgl. im Raum positioniert wird. Die 
Lage des Objektes 1 ist dann unbekannt. Ziel der Lagebestimmung ist es zu- 

15 meist, einen Montage-, Greif- oder Bearbeitungsvorgang an einem Fertigungs- 
objekt 1 in unbekannter Lage durchfuhren zu konnen. Eine Montage muss dabei 
in der Regel immer an einem gleichen Bezugspunkt auf dem Objekt 1 stattfin- 
den. Um dies zu erreichen, muss bei unbekannter Lage des Objektes 1 diese 
gemessen und ein Handhabungsgerat 2, welches das zu montierende Teil an 

20 dem Objekt 1 anbringen soil, entsprechend dem Messergebnis nachgefuhrt 
werden. Die an dem Objekt 1 durchzufuhrenden Aufgaben reichen u.a. vom 
Anbringen von Komponenten, beispielsweise Einsetzen einer Tur in eine Karos- 
se, oder dem gezielten Aufbringen von Material, beispielsweise Klebstoffe oder 
Dichtungsmaterial auf einem Objekt 1 , bis hin zum Durchfuhren von Montage- 

25 bewegungen an dem Objekt, beispielsweise Verschraubung von Verbindungen, 
Verschweifien mechanisch vorpositionierter Teilobjekte oder dgl.. Ferner kann 
es beabsichtigt sein, das Objekt zu greifen, um es zu bewegen. Die Anwendung 
des erfindungsgemafien Verfahrens ist jedoch nicht auf diese Anwendungsfalle 
beschrankt, sondern kann allgemein bei der Lagebestimmung eines beliebigen 

30 Korpers im Raum Verwendung finden. 
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Zur Bestimmung der Lage des Objektes 1 im Raum wird das Objekt 1 mit einer 
Aufnahmeeinrichtung 3, beispielsweise einer optischen Kamera mit einem CCD- 
Sensor, aufgenommen. Dabei wird das Objekt 1 mit Messmerkmalen 4 abgebil- 
5 det, die fur die Auswertung der Lage des Objektes 1 im Raum herangezogen 
werden. Bei diesen Messmerkmalen 4 kann es sich um ausgezeichnete Punkte 
handeln, d.h. punktformige Merkmale, die im Raum keine Orientierung aufwei- 
sen. Ferner konnen geometrische Formen, wie Kreise, Striche, der Schwerpunkt 
eines besonders gekennzeichneten Gebietes, Objektecken oder -kanten oder 

10 sonstige Merkmale herangezogen werden, die in dem von der Aufnahmeeinrich- 
tung 3 aufgenommenen Bild eindeutig identifiziert werden konnen. Wenn die 
Lage des Objektes 1 im Raum in sechs Freiheitsgraden, d.h. im Hinblick auf 
Position und Orientierung, unbekannt ist, werden mindestens drei Messmerkma- 
le 4 zur Auswertung herangezogen, die auf dem Objekt voneinander beabstan- 

15 det sind und in der einen Aufnahmeeinrichtung 3 erfasst werden. Prinzipiell ist 
es jedoch auch mdglich, mehrere Aufnahmeeinrichtungen 3 vorzusehen. 

Durch die Aufnahme der Messmerkmale 4 des Objektes 1 wird in der Aufnah- 
meeinrichtung 3 ein zweidimensionales Abbild des Objektes 1 mit den Mess- 

20 merkmalen 4 erzeugt. In einer an die Aufnahmeeinrichtung 3 angeschlossenen, 
nicht gesondert dargestellten Bildverarbeitungseinrichtung wird das aufgenom- 
mene Bild dann verarbeitet. Aufgrund der dreidimensionalen Kalibrierung der 
Aufnahmeeinrichtung 3 in dem Raum-Koordinatensystem 5, bei dem es sich 
insbesondere um das Weltbezugs-Koordinatensystem handelt, und der bekann- 

25 ten Abbildungseigenschaften der Aufnahmeeinrichtung 3 konnen den Mess- 
merkmalen 4 des Objektes 1 definierte Raumpunkte zugewiesen werden. Da 
gleichzeitig die Koordinaten der Messmerkmale 4 relativ zueinander in dem 
Objekt-Koordinatensystem 6 bekannt sind, lasst sich die Lage des Objektes 1 
sowohl im Hinblick auf die Position als auch die Orientierung im Raum genau 

30 ermitteln. 
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Diese Informationen konnen verwendet werden, urn das Handhabungsgerat 2 
so zu steuern, dass das Objekt 1 beispielsweise an eine vorbestimmte Raum- 
position bewegt wird Oder an dem Handhabungsgerat 2 befindliche Montagege- 
5 genstande positionsgenau an dem Objekt 1 angebracht werden. 

Eine hohe Genauigkeit lasst sich trotz der Auswertung von mehreren Mess- 
merkmalen 4 in einer Aufnahmeeinrichtung 3 dann erreichen, wenn die ausge- 
werteten Messmerkmale 4 auf dem Objekt 1 weit genug auseinanderliegen. In 

10 diesem Fall sind auch die Zwischenwinkel zwischen von den einzelnen Mess- 
merkmalen 4 in die Aufnahmeeinrichtung einfallenden Sehstrahlen 7 ausrei- 
chend grofi, so dass die mathematischen Auswertealgorithmen ein stabiles 
Positionsergebnis liefern. Dabei wird die Position der Aufnahmeeinrichtung 3 
vorzugsweise so gewahlt, dass moglichst viele Sehstrahlen 7 zu fur die Auswer- 

15 tung herangezogenen Messmerkmalen 4 einen moglichst grofien Zwischenwin- 
kel aufweisen. Vorteilhaft ist es, wenn der Zwischenwinkel zwischen Sehstrah- 
len 7 zu moglichst vielen Messmerkmalen jeweils grofier als etwa 10° ist. 

Fig. 2 zeigt ein vergleichbares System zur Durchfuhrung des erfindungsgema- 
20 fien Verfahrens, bei dem die Aufnahmeeinrichtung 3 selbst an einem Handha- 
bungsgerat 8 angebracht ist. In diesem Fall werden in einer ersten Aufnahme- 
position der Aufnahmeeinrichtung 3, welche mit durchgezogenen Strichen dar- 
gestellt ist, ein Teil der fur die Auswertung herangezogenen Messmerkmale 4 
erfasst. Danach wird die Aufnahmeeinrichtung 3 in eine zweite Aufnahmepositi- 
25 on uberfuhrt, welche mit gestrichelten Linien dargestellt ist. In dieser zweiten 
Aufnahmeposition werden weitere Messmerkmale 4 aufgenommen, die fur die 
Auswertung der Lage des Objektes 1 im Raum herangezogen werden. 

Das erfindungsgemafie Verfahren kann, wie in Fig. 3 dargestellt, auch verwen- 
30 det werden, um die Relativverschiebung 9 eines Objektes 1 im Raum zu erfas- 
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sen. Das angewendete Prinzip ist dabei dasselbe, wie in den zuvor beschriebe- 
nen Verfahrensvarianten. Durch eine Aufnahmeeinrichtung 3 werden verschie- 
dene Messmerkmale 4 des Objektes 1 in den verschiedenen Raumpositionen 
erfasst und mittels einer nicht gesondert dargestellten Bildauswertereinrichtung 
5 ausgewertet. Durch Vergleich der verschiedenen Lagen des Objektes 1 im 
Raum zu verschiedenen Zeitpunkten kann dann die Lage des Korpers relativ zu 
einer Nulllage ermittelt werden. 

Der Vorteil des erfindungsgemalien Verfahrens liegt insbesondere darin, dass 
10 mehrere Messmerkmale 4, vorzugsweise bis zu funf Messmerkmale 4, gleich- 
zeitig in einer Auswerteeinrichtung erfasst und ausgewertet werden konnen. 
Dies vereinfacht und beschleunigt die Bestimmung der Objektlage im Raum im 
Vergleich zu bisher bekannten Verfahren erheblich. 
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Bezugszeichenliste: 

1 Objekt 

2 Handhabungsgerat 

3 Aufnahmeeinrichtung 
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6 Objekt-Koordinatensystem 

7 Sehstrahlen 

8 Handhabungsgerat 

9 Relatiwerschiebung 


WO 2005/075936 


PCT/EP2005/000971 


-16- 


Patentanspruche: 

1. Verfahren zur Bestimmung der Lage eines Objekts im Raum (1), bei dem 
5 Messmerkmale (4) des Objekts (1) mit einer auf ein Raum-Koordinatensystem 

(5) kalibrierten optischen Aufnahmeeinrichtung (3) aufgenommen werden und 
anhand dieser Messmerkmale (4) in einer Bildverarbeitungseinrichtung die Lage 
des Objekts (1) in dem Raum-Koordinatensystem (5) bestimmt wird, dadurch 
gekennzeichnet, dass mindestens zwei Messmerkmale (4) des Objekts (1) in 
10 einer Aufnahmeeinrichtung (3) gleichzeitig erfasst und zur Bestimmung der Lage 
des Objekts (1) herangezogen werden. 

2. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, dass mindestens 
drei Messmerkmale (4) aus mindestens einem aufgenommenen Bild ausgewer- 

15 tet werden. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, dass es 
sich bei den Messmerkmalen (4) um ausgezeichnete Punkte handelt. 

20 4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass mehrere Aufnahmeeinrichtungen (3) verwendet werden. 

5. Verfahren nach Anspruch, dadurch gekennzeichnet, dass ein Mess- 
merkmal (4) in mehreren Aufnahmeeinrichtungen (3) abgebildet wird. 

25 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch ge- 
kennzeichnet, dass eine stationare und/oder eine bewegbare Aufnahmeeinrich- 
tung (3) verwendet wird. 
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7. Verfahren nach Anspruch 6, dadurch gekennzeichnet, dass fur eine 
bewegbare Aufnahmeeinrichtung (3) nach einer Bewegung die Lage der Auf- 
nahmeeinrichtung (3) in dem Raum-Koordinatensystem (5) bestimmt wird. 

5 8. Verfahren nach einem der vorhergehenden Anspruche, dadurch ge- 
kennzeichnet, dass die Aufnahmeeinrichtung (3) derart positioniert wird, dass 
zwischen in die Aufnahmeeinrichtung (3) fallenden Sehstrahlen (7), welche von 
verschiedenen Messmerkmalen (4) ausgehen und zur Bestimmung der Lage 
des Objekts (1) herangezogen werden, jeweils ein grolier Zwischenwinkel be- 
10 steht. 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnet, dass der Zwi- 
schenwinkel zwischen etwa 1 0° und etwa 1 70° liegt. 

15 10. Verfahren nach Anspruch 8 oder 9, dadurch gekennzeichnet, dass die 
Aufnahmeeinrichtung (3) derart positioniert und/oder eingerichtet wird, dass 
jeweils ein moglichst grolier Zwischenwinkel besteht. 

11. Verfahren nach einem der vorhergehenden Anspruche, dadurch ge- 
20 kennzeichnet, dass vor Anwendung des Verfahrens die Koordinaten der 
Messmerkmale (4) in einem Objekt-Koordinatensystem (6) erlernt werden, in- 
dem das Objekt (1) in mehreren bekannten Lagen durch die Aufnahmeeinrich- 
tung (3) aufgenommen wird. 

25 12. Verfahren nach einem der vorhergehenden Anspruche, dadurch ge- 
kennzeichnet, dass die Auswahl der von einer Aufnahmeeinrichtung (3) zu 
erfassenden Messmerkmale, die Position der Aufnahmeeinrichtung (3) und/oder 
die Brennweite der Aufnahmeeinrichtung (3) selbsttatig bestimmt werden. 
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